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File: smanc.cl 

Description: Improved Normalized Least Sqiwiros Lattice ANC 

Public Functions: SANC_Calc 

SANC I nit 



Notes : 



This version uses many of the same optimization techniques as the 
..asm version. 



History: 

HGK 04/29/93 



Design Note SDN4 3 Rev A 



#define MODULE_ID 

# include <masimo ; h> 
#include <math.h> 

#include <smanc.h> 

#def3ne MAX(a,b) (a) > 
#def«ne MIN(a,b) (a) < 



1007 

/* platform descriptions 



/* self 



*/ 
*/ 



(b) 
(b) 
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(a) 

(a) 



(b) 
(b) 



#defHene 
#de§*ne 
#de£Bne 
#defgne 
#defjfene 
#defj.ne 
#de&fene 



MIN_VAL 

MAX_DEL 

MIN_DEL 

MAX_RH0 

MIN_RH0 

MAX_BSERR 

MIN BSERR 



0. 01 

0. 99999999999999,99 
-0 . 9999999999 999999 

2.0 
-2 . 0 

1.0 

1E-15 



/* T||e following macros provide efficient access to the lattice */ 



#def;£ne 
#def^ne 
#def4:ne 
#def ine 
#def ine 
#def ine 
#def ine 
#def ine 
#def ine 
#def ine 
#def ine 



xBERR 

xBERR_l 

xdELTA 

XDELTA_1 

XGAMMA 

XGAMMA_1 

XBSERR 

XBSERR_1 

XERR 

XFERR 

xRho 



0 
1 
2 
3 
4 
5 
6 
7 
8 
9 
10 



^define berr 

-define P_berr_l 

^define P_berr 

-define berr_l 

fdefine Bserr 

#define Bserr_l 

? define P_Bserr 1 

^define P delta 
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+ 


xBERR) ) 




(* 


(p 


+ 


XBERR 1 - 


SANC CELL SIZE) ) 


(* 


(p 


+ 


XBERR 


SANC_CELL SIZE) ) 


(* 


(p 


+ 


XBERR ] ) ) 




(* 


(p 


+ 


x BSERR)') 




(* 


(p 


+ 


X BSERR 1) ) 




(* 


(p 


+ 


xBSERR 1 - 


SANC_CELL_SIZE) ) 


(* 


(p 


+ 


x DELTA - SANC_CELL SIZE) ) 



#def i ne 


delta 


I 






xhelta) ) 


fdefme 


delta 1 


(* 


(p 




x DELTA 1 ) ) 


#def ine 


P _delta_l 


(* 


(p 


+ 


xDELTA_ J - SANC ri-LI, STZF) ) 


ydec 1 ne 


err 


(* 


(p 




xERR) ) 


#def ine 


N err 


(* 


(p 




x ERR i sanc: ci:m, :; I XE) ) 


#oe r ine 


P f err 


(* 


(p 


+ 


XFERR - SANC Cbl.L .SIZE) ) 


#def ine 


f err 


(* 


(p 


+ 


XFERR) ) 


#def ine 


gamma 


(* 


(p 




xGAMMA) ) 


#def ine 


P_gamma 


(* 


(p 


+ 


xGAMMA - SANC CELL SIZE)) 


#def ine 


N_gamma 


(* 


(p 


+ 


XGAMMA + SANC_CELL_SIZE) ) 


#de t ine 


P gamma 1, 


(* 


(p 


+ 


XGAMMA 1 - SANC CELL SIZE) ) 


#def ine 


gamma 1 


(* 


(p 




xGAMMA_l)) 


#def ine 


rho 


(* 


(p 




xRho) ) 



FLOAT3 2 
SANC_Calc( 

SANC_DATA *anc, 
FLOAT3 2 nps, 
FLOAT32 noise) 

I&LOAT3 2 
PLOAT3 2 
PLOAT3 2 
pJT3 2 
SpOL 



{ 



/* input, context handle 
/* input, noise plus signal 
/* input, noise reference 



*/ 

*/ 
*/ 



m; 

*p; 

B,F,B2,F2; 
qd2,qd3; 
output_cell ; 
Bf lag; 



BUGl(anc); BUGl(nps); BUG1 (noise); 

ji* Update time delay elements in cell structure 

H = (FLOAT32 *)anc->cells; 

Fbr (m = 0; m <= anc->cc; m++) { 

gamma_l = gamma; 
Wi berr_l = berr; 

Bserr_l = Bserr; 

delta_l = delta; 

p += SANC_CELL_SIZE; 

} 

/* Handle Cell # 0 

p = (FLOAT3 2 *)anc->cells; 

Bserr = anc->lambda * Bserr_l + noise * noise; 
Bserr = MAX(Bserr, MIN_BSERR) ; 

ferr = noise / SQRTF(Bserr) ; 
ferr = MAX (ferr , MIN_DEL) ; 
ferr = MIN(ferr, MAX_DEL) ; 

berr = ferr; 

rho = anc->lambda * SQRTF ( Bserrl / Bserr) * rho + berr * nps; 
N_err = nps - rho * berr; 



/* Initialize Cell v 




output_cell = anc->cc - 1; 
Bflag = FALSE; 

for (m - l; m < anc->cc; m+-f) { 
p += SANC_CELL_SIZE; 

B = SQRTF(1.0 - P_berr_l * p berr 1); 

F - SQRTF(1.0 - P ferr * P~ferr~) ; 



/* Assume last; cell for starter */ 



} 



B2 = 1.0/B; 
F2 = 1.0/F; 



P_delta = P_delta_l * F * B + P__berr_l * P_ferr; 
P_delta = MAX(P_delta, MIN_DEL) ; 



qd3 




1.0 - P delta * P delta 


qd2 




1.0 / SQRTF (qd3 ) ; 


ferr 




(P ferr 


- P delta * 


ferr 




MAX(ferr, 


MIN DEL) ; 


ferr 




MIN(ferr, 


MAX_DEL) ; 


berr 




(P berr 1 


- P delta * 


berr 




MAX(berr, 


MIN DEL) ; 


berr 




MIN(berr, 


MAX_DEL) ; 


gamma 




P_gamma * 


(1.0 - P berr 


gamma 




MAX (gamma , 


MIN VAL) ; 


gamma 




MIN (gamma , 


MAXJ3EL) ; 


Bserr 




P_Bserr_l 


* gd3; 



qd2 * F2; 



/* update cell voter 

if(Bserr < anc->voter && Bflag == FALSE) { 

output_cell = m; 

Bflag = TRUE; 

} 

Bserr = MAX(Bserr, MIN_BSERR) ; 



rho *= 

rho += 

rho = 
rho 



anc->lambda * SQRTF ( (Bserr_l / Bserr) * (gamma / gamma 1) ) ; 
berr * err; ~ 
MAX(rho, MIN_RHO) ; 
MIN (rho, MAX_RHO) ; 



N_err = err - rho * berr; 



p ~ (FLOAT32 *) & (anc->cells[output cell /* *ANC CELL SIZE */l); 
return (N_err) ; ~ ~ 



/OID 

^ANC_Init ( 

SANC_DATA 

FLOAT3 2 
INT32 



r anc) 



*p; 

m; 



/* input, context pointer 



BUG1 (anc) ; 



p = 



(FLOAT3 2 
.0 ; m 



for (m 
rho 
err 

f err = 
berr 
berr_l 
delta 
delta_l = 
Bserr = 
Bserr_l = 
gamma = 
gamma_l = 
P += 

} 

p = ( FLOAT3 2 
gamma = l.o 
gamma_l = l.o 



is; 
r cc; m -M ) 



*) anc- 
<= an 
0.0; 
0.0; 
0.0; 
0.0; 
0.0; 
0.0; 
0.0; 

anc->inin_error ; 
anc->min_error ; 
MIN_VAL; 
MIN_VAL; 
SANC_CELL_SIZE; 

*) anc->cells; 



